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TRANSLATIONAL MODE IS PERFORMED 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fxtmp 
WHEN HORIZONTAL BODY ACCELERATION IS a tmp. 



S3106 



S3110 



S3108 Fxtmp >Fxmax 



Fxtmp < Fxmin 




DETERMINE HORIZONTAL COMPONENT Fx OF FLOOR REACTION 
FORCE ACCORDING TO THE FOLLOWING EQUATION: Fx = Fxmax 



Fx = Fxmin 



Fx = Fxtmp 



S3112 
S3114 



S3U6 



DETERMINE HORIZONTAL BODY ACCELERATION a OF BODY TRANSLATIONAL MODE 

AND BODY ANGULAR ACCELERATION B OF BODY ROTATION MODE ACCORDING TO 

THE FOLLOWING EQUATIONS: 

a = atmp+ (Fx— Fxtmp) /AFp 

B =(atmp— a) * AMp/AMr 



S3118 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mztmp WHEN IT IS 
ASSUMED THAT MOTION OF HORIZONTAL BODY ACCELERATION OF BODY TRANSLATIONAL 
MODE DENOTED AS a , BODY ANGULAR ACCELERATION OF BODY ROTATION MODE 
DENOTED B , AND ANTIPHASE ARM SWING ANGULAR ACCELERATION DENOTED AS 
B aref IS PERFORMED. 



S3120 Mztmp >Mzmax 



Mztmp 



s Mztmp < Mzmin 



DETERMINE FLOOR REACTION FORCE MOMENT 
VERTICAL COMPONENT Mz ACCORDING TO THE 
FOLLOWING EQUATION: Mz = Mzmax 



S3122 



else 



Mz = Mzmin 



Mz = Mztmp 



S3124 
S3126 



S3128 



DETERMINE ANTIPHASE ARM SWING ANGULAR ACCELERATION B a ACCORDING 
TO THE FOLLOWING EQUATION: Ba = B aref + (Mz-Mztmp) /A Ma 



S3130 



DETERMINE HORIZONTAL BODY ACCELERATION a REQUIRED TO GENERATE MODEL 
MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED 
ZMP AT CURRENT TIME (TIME k) IF MOTION OF BODY TRANSLATIONAL MODE IS PERFORMED. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a . 



S3132 



B =0 

B a = B aref 
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FIG.60 



INITIALIZATION (1=0, ETC.) | S2010 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL aCLE).| S201 4 



S2012 



oo 



S2016 



yes 



IS GAIT 
CHANGING? 



I 



1 = 0 | S2018 



S2020 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2022 



S2024 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, 
AND INITIAL ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS OF CURRENT TIME GAIT. 



S2026 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S2028 



S2030 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPLIANCE CONTROL 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR REACTION 
FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS ZERO.) 



S2032 



S2034 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECTED GAIT 
(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 
FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 
ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP WHILE CORRECTING DESIRED ZMP 
AND ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN TO APPROXIMATE 
TO ORIGINAL GAIT AT THE SAME TIME.) __ 



t=t+At 
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FIG.61 



DETERMINE DESIRED ZMP AT CURRENT TIME ON 
THE BASIS OF GAIT PARAMETERS. 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL 
COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2100 



S2102 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



S2106 



CALCULATE VERTICAL BODY POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



S2108 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmox] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2110 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2111 



DETERMINE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Mxymin,Mxymax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2112 



S2114 



DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT, 
DESIRED FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) 
FOR COMPLIANCE CONTROL, BODY HORIZONTAL ACCELERATION, BODY POSTURE INCLINATION 
ANGULAR ACCELERATION, AND ANTIPHASE ARM SWING ANGULAR ACCELERATION SUCH THAT 
CONDITIONS OF FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE, FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, 
AND FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE ARE SATISFIED. 



S2U6 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGULAR VELOCITY. 

FURTHER INTEGRATE THE RESULTTO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE. 



S2118 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE ANTIPHASE ARM SWING ANGULAR 
VELOCITY. FURTHER INTEGRATE THE RESULT TO DETERMINE ANTIPHASE ARM SWING ANGLE. 
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ENTRY 



3 



FIG.62 



DETERMINE DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN HORIZONTAL BODY POSITION OF 
CORRECTED GAIT AND HORIZONTAL BODY POSITION OF ORIGINAL GAIT. 



S2200 



DETERMINE DIFFERENCE IN BODY POSTURE INCLINATION ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN BODY POSTURE INCLINATION ANGLE OF CORRECTED 
GAIT AND BODY POSTURE INCLINATION ANGLE OF ORIGINAL GAIT. 



S2202 



DETERMINE DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN ANTIPHASE ARM SWING ANGLE OF 
CORRECTED GAIT AND ANTIPHASE ARM SWING ANGLE OF ORIGINAL GAIT. 



S2204 



DETERMINE REQUIRED VALUE OF MODEL HORIZONTAL BODY POSITION STABILIZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS. 



S2206 



DETERMINE REQUIRED VALUE OF MODEL BODY POSTURE INCLINATION ANGLE STABILIZATION 
FLOOR REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS 
OF DIFFERENCE IN BODY POSTURE INCLINATION ANGLE BETWEEN MODELS. 



DETERMINE REQUIRED VALUE OF MODEL ANTIPHASE ARM SWING ANGLE STABILIZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS. 



S2208 

S2210 
S22T2 



DETERMINE MODEL HORIZONTAL BODY POSITION STABILIZATION MOMENT, MODEL BODY POSTURE ANGLE 
STABILIZATION MOMENT, MODEL ANTIPHASE ARM SWING ANGLE STABILIZATION MOMENT, HORIZONTAL 
BODY ACCELERATION, BODY POSTURE ANGULAR VELOCITY, AND ANTIPHASE ARM SWING ANGULAR 
ACCELERATION SUCH THAT THEY SATISFY RESTORING CONDITIONS. 



MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 
= MODEL HORIZONTAL BODY POSITION STABILIZATION MOMENT 
+ MODEL BODY POSTURE ANGLE STABILIZATION MOMENT 



S2214 



DESIRED aOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT FOR COMPLIANCE CONTROL 
= COMPENSATING TOTAL FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT Mdmdxy 
+ MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 



S2216 



DESIRED FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT FOR COMPLIANCE CONTROL 
= COMPENSATING TOTAL FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT Mdmdz 
+ aOOR REACTION FORCE MOMENT VERTICAL COMPONENT BALANCING WITH CORRECTED GAIT 



S2218 
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FIG.65 

ZMP PERMISSIBLE RANGE 
(FLOOR REACTION FORCE CENTRAL 
POINT PERMISSIBLE RANGE) 



Y (LEFT) 




DESIRED ZMP 



LEFT FOOT 



X (FRONT) 



RIGHT FOOT 
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( START ) 



FIG.66 



INITIALIZATION (t=0, ETC) 



S3510 



S3512 



oo 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). | $3514 



S3516 yes 



IS GAIT 
CHANGING? 



t = 0 | $3518 



S3520 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S3522 



S3524 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, AND INITIAL 
ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S3526 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S3528 



S3530 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE HORIZONTAL COMPONENT 
PERMISSIBLE RANGE, FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION FORCE MOMENT 
VERTICAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



S3532 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CURRENT TIME GAIT 
(DETERMINE IT SUCH THAT DESIRED ZMP IS SATISFIED, FLOOR REACTION FORCE MOMENT 
HORIZONTAL COMPONENT DOES NOT EXCEED FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT 
DOES NOT EXCEED FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE.) 



DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE, FLOOR REACTION 
FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



S3534 



GENERATE CORRECTED GAIT USING FULL MODEL | $3536 



t=t+At 



( END ) 
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FIG.68 



HORIZONTAL BODY 
POSITION CORRECTING 
PERTURBATION MODEL 



SUPPORTING POINT 



BODY MASS POINT HORIZONTAL POSITION xc 

BODY MASS POINT (MASS POINT OF INVERTED PENDULUM) 




HEIGHT OF 

INVERTED 

PENDULUM 



BODY MASS POINT 
VERTICAL POSITION 
Zc(=Zb) 



-►X 

DESIRED ZMP VERTICAL POSITION 



FIG.69 

BODY POSTURE ANGLE CORRECTING 
PERTURBATION MODEL 



INERTIAL MOMENT J 



FLYWHEEL 
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FIG.70 



ANTIPHASE ARM SWING ANGLE 
CORRECTING PERTURBATION MODEL 
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FIG.78 



INITIALIZATION (1=0, ETC) 



S2310 



S2312 



oo 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). | S2314 



S2316 yes 



IS GAIT 
CHANGING? 



I 



1 = 0 



S2018 



S2320 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2322 



S2324 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, AND INITIAL 
ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S2326 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S2328 



S2330 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPLIANCE CONTROL 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR 
REACTION FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS 0.) 



S2332 



S2334 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECTED GAIT 

(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 

aOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 

ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP, WHILE CORRECTING DESIRED ZMP 

AND ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN SO AS TO 

APPROXIMATE TO ORIGINAL GAIT AT THE SAME TIME. HOWEVER, FLOOR REACTION 

FORCE PERMISSIBLE RANGE IS CHANGED ACCORDING TO RESULT OF SUPPAGE DETERMINATION.) 
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( END ) 
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( ENTRY ) 



FIG.79 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL 
COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5100 



DETERMINE DESIRED ZMP AT CURRENT TIME ON 
THE BASIS OF GAIT PARAMETERS. 



S5102 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 



S5106 



CALCULATE VERTICAL BODY POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



S5108 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5110 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5112 



DETERMINE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE f Mxvmin.Mxymax1 AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 
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S5116 



RESULT OF SUPPAGE 
DETERMINATION 
= IS THERE SLIPPAGE? 1 




_ S5118 

GRADUALLY APPROXIMATE PERMISSIBLE RANGE REDUCING RATE att TO 0. | 

$5120 

GRADUALLY APPROXIMATE PERMISSIBLE RANGE REDUCING RATE ott TO 1. j 



MULTIPLY Fxmin, Fxmax, Mzmin, AND Mzmax BY REDUCING RATE aft SO AS TO NARROW 
FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE AND FLOOR 
REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE RANGE 
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DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT, 
DESIRED FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) 
FOR COMPLIANCE CONTROL, BODY HORIZONTAL ACCELERATION, BODY POSTURE INCLINATION 
ANGULAR ACCELERATION, AND ANTIPHASE ARM SWING ANGULAR ACCELERATION SUCH THAT 
CONDITIONS OF FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE, FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, 
AND FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE ARE SATISFIED. 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGULAR VELOCITY. 

FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE. 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE HORIZONTAL BODY VELOCITY 
AND ANTIPHASE ARM SWING ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO 
DETERMINE ANTIPHASE ARM SWING ANGLE. 



( RETURN ) 



S5126 



S5128 



Title: "GAIT GENERATING DEVICE OF LEGGED MOBILE ROBOT AND LEGGED MOBILE ROBOT CONTROLLER" 

-First Named Inventor: Toru Takenaka 
National Stage of PCT/JP2004/009476 
Customer No. 40854; Docket No. SAT-16306 
Page 69 of 75 



69/75 



FIG.80 



C START ) 



SPIN DETERMINING SUBROUTINE 
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TRANSLATIONS SLIPPAGE DETERMINING SUBROUTINE 
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SLIPPAGE VIBRATION DETERMINING SUBROUTINE 
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yes 
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DOES DETERMINATION 
RESULT INDICATE 
PRESENCE OF 
SPIN OR SKID OR 
SLIPPAGE VIBRATION?\no 




SLIPPAGE DETERMINATION RESULT = SLIPPAGE 
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SLIPPAGE DETERMINATION RESULT = NO SLIPPAGE 
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FIG.81 
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DETERMINE GROUND ANGULAR VELOCITY VERTICAL COMPONENT usupz OF 
FOOT OF THE SUPPORTING LEG ON THE BASIS OF ACTUAL BODY POSTURE 
ANGULAR VELOCITY AND JOINT ANGLE COMMAND (DETECTION VALUE). 



S5310 



DETERMINE CHANGING RATE dMsupactz/dt OF SUPPORTING LEG FLOOR 
REACTION FORCE MOMENT VERTICAL COMPONENT. 
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S5314 



yes 



I cusupz I >coe ?i 



DETERMINE APPARENT TWIST SPRING CONSTANT Ksupt 
OF SUPPORTING LEG (=(-dMsupactz/dt)/a>supz). 
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SPIN DETERMINATION RESULT = SPIN 
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SPIN DETERMINATION RESULT = NO SPIN 



SPIN DETERMINATION RESULT = NO SPIN 
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FIG.82 
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S5410 

DETERMINE GROUND TRANSLATIONS VELOCITY HORIZONTAL COMPONENT Vsupxy OF 
FEET OF THE SUPPORTING LEG ON THE BASIS OF ACTUAL BODY POSTURE ANGULAR VELOCITY, 
DETECTION VALUE OF ACCELERATION, AND JOINT ANGLE COMMAND (DETECTION VALUE). 



DETERMINE CHANGING RATE dFsupactxy/dt OF SUPPORTING LEG 
FLOOR REACTION FORCE HORIZONTAL COMPONENT. 
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S5414 



yes 



Vsupxy I >Ve ?, 



DETERMINE APPARENT SHEAR SPRING 
CONSTANT Ksups OF SUPPORTING 
LEG (=(-dFsupactxy/dt)/Vsupxy). 
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Ksups<Ksupsmin? 




TRANSLATIONAL SLIPPAGE DETERMINATION RESULT 
= TRANSIATIOMAL SLIPPAGE 
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TRANSLATIONAL SLIPPAGE DETERMINATION RESULT 
= NO TRANSLATIONAL SLIPPAGE 



TRANSLATIONAL SLIPPAGE DETERMINATION RESULT 
= NO TRANSLATIONAL SLIPPAGE 
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FIG.83 
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PASS DETECTION VALUE OF FOOT 6-AXIS FORCE SENSOR THROUGH 
BAND-PASS FILTER TO EXTRACT SLIPPAGE VIBRATION COMPONENT 



S5510 



S5512 



S5514 



yes 



I MAGNITUDE OF SLIPPAGE 
VIBRATION 

COMPONENT I >Ampe? 




SLIPPAGE VIBRATION DETERMINATION RESULT 
= SLIPPAGE VIBRATION 
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SLIPPAGE VIBRATION DETERMINATION RESULT 
= N0 SLIPPAGE VIBRATION 
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FIG.84 
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